function repulsiveForce = calcurepulsiveForce(repulsiveForce,positionNow,objMat,m,r,angleObj,objNumber)
    for ki=1:objNumber
    p0=sqrt((positionNow(1)-objMat(ki,1))^2+(positionNow(2)-objMat(ki,2))^2+(positionNow(3)-objMat(ki,3))^2);
        if p0>r
            repulsiveForce=repulsiveForce+0;
        else
            repulsiveForce=repulsiveForce-m*(1/p0-1/r)*(1/p0^2)*angleObj(:,ki);

        end
    end
end